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ABSTRACT 


In support of NASA ERC's V/STOL. Avionics Systems Research 
Program, IBM derived, programmed, and verified the equations for the 
Gemini computer which was flown onboard an H-19 helicopter to test radar 
update of the onboard inertial navigation system. With the primary purpose 
being to demonstrate all weather landing capability, the radar update is 
necessary to remove the accrued errors of the onboard system prior to 
the terminal landing phase. The navigation equations accept accelerometer 
outputs from the Gemini IMU and compute the vehicle's position and velocity 
in an earth surface fixed frame. When commanded via telemetry, the 
computer accepts radar position measurements, filters the data to obtain 
estimates of position and velocity, and updates the onboard navigation 
quantities. The resulting flight test results attest to the validity of both 
the equations and the approach. 
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SUMMARY 


Under NASA Contract Number NAS 12-610, IBM derived, programmed, 
and verified the equations implemented in the Gemini computer which was 
flown onboard the H-19 helicopter during Phase IB of the Electronic 
Research Center's V/STOL Avionics Research Program- The equations 
perform onboard navigation with radar update capability- 'Navigation is 
performed in either of two earth- surface -fixed rectangular coordinate, 
frames; the cruise frame with its origin at the liftoff point, or the approach 
frame with its origin at the touchdown point. 

The technique selected for updating the onboard navigation system 
is based primarily cin the digital command system's transmission rate of 
one data block per second, and the Gemini computer's relatively slow 
computational speed. The resulting approach utilizes a radar data pre- 
processor filter which supplies independent samples of position and velocity 
estimates to the mixing filter at a cycle rate slower than the transmission 
rate. This allows all available radar data to be utilized in such a manner 
that the computer speed is not a limiting factor. The mixing filter 
combines the preprocessor outputs of velocity and position estimates with 
the onboard information, and updates the navigation position and velocity 
with the results. . Either of two mixing filters may be chosen. 

vii 



The equations and associated logic were verified via simulation 
at both the Fortran and Gemini operational program level. These 
results indicated that the computational errors were at least an order 
of magnitude less then those due to the IMXJ. The resulting flight test 
results attest to the validity of both the equations and the approach. 
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Section 1 


INTRODUCTION 

This report describes the work performed by IBM under NASA 
Contract Number 12-610 in support of Phase IB of the ERC's V/STOL 
Avionics Systems Flight Test Program. This phase, which utilizes 
Gemini hardware, concentrated on the guidance and navigation require- 
ments for an all weather avionics system; with particular emphasis on 
the critical landing and approach phase. Flight tests of the resulting 
systems were conducted at Wallops Station, Virginia, where a GSN-5 
radar was used to update the inertial system flown onboard the H-19 
helicopter. A brief discussion of the basis system components and 
typical flight sequence is contained in Section^2. 

■ Section 3 describes the navigation equations, their implementation, 
and the basis for the navigation frame selection. Navigation is performed 
in either of two earth-surfaced- fixed frames; the cruise frame with its 
origin at the liftoff point, or the approach frame with- its origin at the 
touchdown point. 

The technique selected for updating the onboard navigation system 
from radar position measurements is discussed in ‘Section 4. -To utilize 
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all available radar data, which is transmitted at one second intervals, a 
preprocessor filter and a mixing (update) filter are used in such a manner 
that the Gemini computer's relatively slow computation speed is not a 
limiting factor. The preprocessor filter, which is a modified version of 
exponentially weighted least squares, processes all of the radar measure- 
ments and supplies independent estimates of position and velocity to the 
mixing filter at some prechosen multiple of the one second transmission 
interval. 

The mixing filter combines the preprocessor outputs of position and 
velocity estimates with the existing onboard navigation values of position 
and velocity. Either of two mixing filters may be chosen; a six/nine state 
filter with prestored weights, or the "Koenke" filter which replaces the 
onboard navigation position and velocity values with the estimates, derived 
from the radar data, during the first update cycle and equally weights the 
estimates and existing navigation quantities thereafter. 

The resulting flight software is described in Section 5, including a 
typical sequence of events necessary to exercise the computer program. 

The methods used for program verification are also discussed, including 
a brief discription of the simulation programs and typical simulation results. 

Appendices A and B contain detailed derivations of the navigation 
equations and preprocessor filter equations respectively. Appendix C 
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contains the latest Revision B level of the Phase IB software and includes 


a math flow symbol list. The flight software input/ output quantities and 
their range and formats are contained in Appendix D. 
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Section 2 


SYSTEM FUNCTIONAL DESCRIPTION 
The basic flight test system components as indicated in Figure 2-1 

are: 

• Inertial Measuring Unit (IMU) 

• Onboard Digital Flight Computer 

• GSN-5 Radar 

• Digital Command System (DCS) 

• Digital Acquisition System (DAS) 

• Flight Data Recording Equipment 

The output pulses from the triad of pulse rebalance accelerometers 
mounted on the inertial platform are accumulated in buffer storage registers. 
These are periodically (nominally one second intervals) sampled and cleared 
by the computer which converts them into increments in velocity. Using 
these inputs the computer solves the navigation equations to obtain the 
vehicle's present position and velocity. 

Navigation is initiated in the cruise frame (origin at liftoff point), 
but can be switched to approach frame (origin at touchdown point) 
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navigation at any time by the proper DCS command. The update mode may 
also be initiated at any time via DCS command. However, unless the 
cruise and approach frames are collinear, update must be limited to the 
approach mode since the radar data is supplied in this frame. 

Where the flight plan allows, the GSN-5 radar tracks the vehicle 
continuously in order that reference data may be recorded for post flight 
analysis. Twenty-one quantities of onboard flight data are transmitted to 
ground recorders via the DAS at 2. 4 second intervals. The 2.4 second 
interval is dictated by the Gemini .DAS hardware. Since the basic compu- 
tation cycle is one second, the flight software utilizes buffer storage to 
assure that all quantities in each transmitted data block pertain to the 
same flight time. 

A typical flight sequence starts with inertial platform alignment with 
the y axis along the local vertical and the x and z axis nominally East and 
North, although any azimuth is feasible. After IMU stabilization, and 
determination of the IMU error correction coefficients, any required 
changes to the navigation initial conditions and/or correction coefficients 
stored in the computer are made via the Manual Data Insertion Unit (MDIU). 

Navigation is initiated by the computer "start comp" button which 
also frees the caged inertial platform. At the specified time the switch from 
cruise to approach frame navigation is initiated by manual DCS command. 
Another DCS command initiates the update mode, at which time the flight 
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computer starts processing the radar data. A block of radar data, consisting 
of time and the three components of position, is transmitted at one second 
intervals. The computer smoothes several, e.g. , ten seconds, of radar 
data and computes an estimate of position and velocity. Using prestored 
gains, these estimates are combined with the existing navigation position 
and velocity to obtain the updated values. The updating continues until a 
DCS command to return to pure inertial navigation is transmitted. This 
nominally occurs in the early stage of the landing approach phase. 

To obtain a measure of the updated system accuracy, stationary 
navigation is usually continued for a period of time, e.g.,. fifteen minutes, 
after touchdown. This provides an excellent check since the correct 
solution for velocity and position at the touchdown point is identically zero. 

Stationary navigation is also usually performed prior to the actual 
flight test. By monitoring the navigation outputs, required adjustments 
to the IMU error correction coefficients can be determined and entered 
into the flight computer. 
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Section 3 


NAVIGATION EQUATIONS 

Navigation is performed in either of two earth- surface -fixed 
rectangular coordinate frames; the cruise frame with its origin at the 
liftoff point, or the approach frame with its origin at the touchdown 
point. Thus, the vehicle's position is supplied with respect to the liftoff 
point until switchover is commanded, and is thereafter supplied relative 
to the touchdown point. The approach frame is also defined to be 
collinear with the radar frame, thereby simplifying the computation 
required for radar update of the onboard system prior to touchdown. 

The choice of the earth- surface -fixed frames has the additional advantage 
of improved computational accuracy as it allows a more desirable choice 
of variable scaling for the Gemini computer software. 

Navigation Frame Selection 

There are several schemes which might be implemented in the 
V/STOL Phase IB equations. Three basic schemes (there are several 
variations) are: 

1 

Jjc 

The GSN-5 radar, which provides data in a cartesian earth- surface - 
fixed frame, has the capability of offsetting its coordinate frame origin to 
the desired touchdown point. 
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1. Navigate in an earth surface fixed (ESF) frame and combine 
the radar data with the navigation data in this frame. 

2. Navigate in an earth centered inertial (ECI) frame and transform 
the radar data into the ECI frame) prior to combining. The 
combining of IMU and radar data would be in ECI coordinates. 

3. Navigate in an ECI frame and transform the position and velocity- 
data into the ESF frame prior to combining with the radar data. 

The dominant factors in selecting one of these three basic schemes 
are equation complexity (e. g. , number of transformation required, 

J 

computer solution time), numerical problems (e.g. , scaling, roundoff, 
truncation), and statistical considerations (e. g. , data correlations, noise 
power reduction). The first scheme listed above and the one selected has 
the following desirable properties. 

1. Reduced scaling problems by virtue that, in the ESF frame, 
only relative distances and velocities between the V/STOL 
aircraft and some origin (takeoff pr landing sites) appear in 
the output registers. 

2. Reduction in the effect of errors induced by trigonometric 

■ , ' ■ 

subroutines. In the ESF scheme an error in a trigonometric - 

\ . 

function is roughly equivalent to an error in aligning the platform 
since trigonometric functions appear only in the differential 
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3 . 


equations as rotations of acceleration components. The trigono- 

**6 — 7 

metric error is on the order of 10 to 10 . Thus, the 

corresponding platform error is one micro "g" or less. 

Computer induced errors do not propagate through the mixing 
filters. In the ESF scheme, accumulated error induced by the 
computations are eliminated at the first radar update since at 
the first update the filter weights place all of the weight on the 
radar data and little on the navigation data. Thereafter, the 
only computer induced errors are those which are equivalent 
to platform misalignments and these have been shown to be 
negligible. 

4. For the stationary navigation problem, the nominal state of the 
position and velocity registers must be zero in the ESF frame. 
For the other two schemes, a nominal trajectory would have to 
be stored or computed. The effect of computer induced errors 
could 'cause non zero conditions which might be difficult to 
distinguish from other errors. Thus, preflight checkout or 
alignment is easier to implement in the ESF frame. 

5. Since the elevation angle is expected to be less than six degrees 
and since the basic uncorrelated radar measurements are range, 
azimuth, and elevation, the correlations among the transformed 
cartesian ESF radar data (i. e. , x, y, z) are also small. Hence, 
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the digital filter needed to process the radar data from raw . 
position to smoothed position and velocity may be implemented 
as three two -state uncoupled filters instead of one six- state 
totally coupled filter. 

If the second scheme had been selected, the complexity would have 
been reduced in the navigation equations (fewer acceleration components 
to be computed) but increased in the digital filter equations because in 
order to have the same noise power reduction characteristics a totally 
coupled filter would have had to be implemented. The radar noise in ECI 
coordinates cannot be expected to be uncorrelated. 

In the translation of radar data into the ECI frame, an error in the 
trigonometric subroutine can cause computer induced errors on the order 
of 20 feet. These 20 feet errors are systematic, and digital filtering 
cannot remove them- 

The third basic scheme is the most complex with respect to the 
navigation equations but has the same digital filter complexity as the first 
scheme. The increase in complexity in the navigation equations is necessary 
because both position and velocity information must be transformed from 
ECI to ESF, i. e. , the mixing filter provides for both position and velocity 
mixing. The numerical error caused by trigonometric subroutines is also 
present with third scheme. For these reasons the third scheme was 
discarded. 
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Time did not permit a complete quantitative tradeoff between schemes 
one and two. However, it appeared that the first scheme would prove to 
have fewer numberical problems with no risk in programming due to 
complexity. The potential complexity problem was circumvented via 
matrix development of the equations which organized and simplified the 
bookkeeping problems. The actual scheme mechanized uses two ESF 
frames. The reason for doing so was primarily esthetic. The navigator 
initially uses the data in the form of distance and velocity from the liftoff 
point and later in the flight in the form of distance and velocity to go to 
the touchdown point. The "y" channel indicates the distance and velocity 
normal to a line joining the liftoff and touchdown points and so in effect 
yields "off course" information. The "x" channel indicates the distance . 
traveled or the distance -to-go to touchdown. The z channel does not 
reflect altitude but height above the tangent plane. This is no loss or 
compromise because no coordinate frame can provide altitude without a 
detailed map of terrain fluctuations. However, in the ESF- frame the 
interchanging of z and altitude becomes perfectly valid at the beginning 
and end of the flight. 

Coordinate Axes 

The inertial platform and cruise navigation axes are indicated in 
Figure 3-1. At liftoff (t = 0) the origin of the platform frame {X^, Y^, Z^) 
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and the origin of the navigation frame (X^, Y c> Z^} are coincident. As 
shown, the platform may be aligned at arbitrary azimuth angles from the 
nominal North-East orientation. Either or both of the navigation frames 
may also be aligned at arbitrary azimuth angles with respect to the North- 
East nominal. In all three cases, a positive azimuth is defined as a 
positive rotation about the axis along the plumb-bob vertical of the particular 
frame. 


Equation Implementation 


A detailed derivation of the navigation equations is presented in 
Appendix A. The resulting implementation is summarized in Figure 3-2, 
where the three element vectors are defined as follows: 


R 


Computed position relative to the liftoff or touchdown point. 


R 


Computed velocity relative to the liftoff or touchdown point. 


ar' 

P 

mm 

R 


R 

cp 


Increments of sensed velocity in navigation frame. 
Corrected accelerometer outputs in platform frame. 

V 

Computed acceleration due to coriolis, centrifugal, and 
gravity. 

Navigation position predicted forward one -half integration 
interval. 
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As implied by the above, the same equations are solved for either 
navigation frame. All that is required to switch from cruise to approach 
is a reinitialization. The detailed equations are contained in the system 
math flow in Appendix C. 

The navigation equations are solved at one second intervals using 
trapezoidal integration. As derived in Appendix A, a one -half cycle 
predictor is used in the position feedback loop to offset the one cycle 
computational transport lag. This assures the correct phase of the overall 
position feedback loop. 

Since the flight tests are limited to relatively short ranges, an 
equivalent spherical earth gravity model provides sufficient accuracy. 
However, in the absence of onboard altimeter information, the magnitude 
of gravity is held constant, i. e. , it is not a function of altitude. This is 
necessary to prevent the vertical channel instability; and during the critical 
landing approach phase, after radar update, the resulting gravity error is 
negligible. 

The IMU compensation equations, as contained in the system math 
flow in Appendix C, are reproduced in Figure 3-3. It shows the compu- 
tational sequence from accelerometer output (F^, F^, F,^} * n <l uan t a 

• # # . 

to the corrected accelerometer output (AX , AY , AZ ) in feet/second, 

■ p p p 

After correcting for accelerometer bias and misalignment and applying 
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F^, F , (Accelerometer outputs — Quanta) 



♦ # « 

AX , AY , A Z (Corrected accelerometer outputs — FPS) 

P P P 


Figure 3-3 IMU Compensation Equations 
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the scale factor, the platform drift correction is made using small angle 
approximations. The sign convention employed is that a positive fixed 
drift rate (D , D , D ) causes a positive gyro gimbal drift which results 
in a negative platform drift. The same convention applies for the mass 
unbalance terms with positive input axis accelerations. The orientation 
of the gyro axes relative to the platform axes is shown in Figure 3-4. 



Legend: 

X_, Y y Z -• Platform Axes 

P P P 

0 - G/ro Output Axis 

S - Gyro Spin Axis 

1 - Gyro Input Axis 


Figure 3-4 Platform/Gyro Reference Axes 
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Section 4 


RADAR UPDATE EQUATIONS 

The technique selected for updating the onboard navigation system 
is based primarily on the DCS transmission rate and the computational 
speed of the Gemini computer. The DCS transmits one set of data, 
consisting of time and the three components of radar measured position, 
each second. (Between eight and nine hundred milliseconds per data set 
is actually required. ) To obtain the potential accuracy available, the raw 
radar data should be processed at the transmission rate. At this compu- 
tational rate, however, the type of filtering that may be employed is 
limited by the speed of the Gemini computer. For example, to execute 
a Kalman type filter, where the weighting coefficients are computed in 
real time, requires considerably greater then the available one second 
per cycle. 

The efficient alternative which was chosen preprocesses the raw 
radar position data at its transmission rate of once per second. The 
preprocessor filter supplies essentially statistically independent samples 
of both position and velocity estimates to the mixing filter at a fixed cycle 
rate which is slower then the transmission rate. By this approach all 
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available data is utilized in such a manner that the computer speed is 
not a limiting factor. The velocity estimates, in effect, compensate 
for the slower sampling rate. 

Preprocessor Filter Characteristics 

The preprocessor filter is a modified version of recursive 
exponentially weighted least squares. A detailed derivation and 
comparison of characteristics with classic least squares and exponent- 
ially weighted least squares are contained in Appendix B. As shown in 
Appendix B, under steady- state conditions, the preprocessor filter and 
exponentially weighted least squares have identical characteristics. 

The preprocessor filter fits a linear function of time to the 
measurements. The equations are: 

(4-1) R = R , + T R . 

p n-1 n- 1 

(4-2) AR=R -R 

r p 

(4-3) R sR + K, AR 

n p 1 

(.4-4) T R = T R , + K AR 

n n-1 2 

where the three element vectors are: 

R_^ Predicted position 

R Latest measurement with inherent noise 

r 
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End point position estimate 


End point velocity estimate 


The precomputed filter gains are: 


K 1 - 1 - z o 


K = (1 - Z ) 
2 o 


where Z = e where T is the measurement interval and 7" is the 
o 

filter time constant. 

Table 4-1 compares pertinent steady-state characteristics of the 
preprocessor filter to classic least squares as a function of and n. 
Somewhat more informative are the curves in Figure 4-1 and 4-2, 
where the square root of the ratio of the noise variance of the estimates 
to the noise variance of the measurements is plotted versus the bias 
error that would result from a constant acceleration input. The trade- 
off that must be made between a long memory filter for noise reduction, 
and a. short memory filter to limit bias error growth must obviously be 
tailored to the system in question. 

Although classic least squares is slightly superior in performance, 
the recursive preprocessor filter has significant advantages from the 
standpoint of implementation. Since the gains are only a function of 
Z^, its memory length may be adjusted by changing only one quantity 
thereby much simplifying the programming requirements. This is 
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PREPROCESSOR FILTER 


CLASSIC LEAST SQUARES 


(1 - Z )((I + Z ) Z - 2 Z ) Z 
o " o' , o 

(N + 1)(N + 2) (( 2N+1 > 3 k) Z 

k-o 

(Z - zf 

(1 - Z ) 2 Z {Z - 1) 

• Q 

■ 6 N ’ 

N(N + l)(N + 2)£ (N-2WZ • 
k=o 

(Z - zf 

(1 - Z o ) (l + 4Z o + 5Z^) 
(1 + zf 

2 (2N + 1) 
(N + 1)(N + 2) 

2(1 - Z ) 3 
o 

12 

(itz/ 

N (N + 1)(N + 2) 

7 2 


JLt 

O 

N (N - 1) 

d - zf 

12 

(1 + 3 Z ) 
o 

N 

2 (1 - Z o > 

2 

TABLE 4-1 STEADY-STATE CHARACTERISTICS 











particularly convenient for test programs such as this where the noise 
models etc. are not well known and changes may be required from flight 
to flight. 

As previously indicated, the primary purpose of the preprocessor 
filter is to slow the solution rate, from the once per second transmission 
rate, without discarding any data. However, in order to keep the mixing 
filter near optimum requires that its inputs (the preprocessor filter 
outputs at the slower rate) be uncorrelated. The preprocessor auto- 

“T* 

correlations and cross correlations for unity power white noise input 
are plotted for various values of in Figures 4-3, 4-4, and 4-5. The 
correlation times agree very closely with the number of measurements 
required for classic least squares as plotted in Figures 4-1 and 4-2. 

For example, with Z q = 0. 7, the normalized autocorrelation 
time for any estimator is less than 0. 1 for nT >10. A sliding least 
squares batch filter with 10 data point memory produces a statistically 
independent estimate for nT > 10. Therefore, either a 10 data point least 
squares filter or the preprocessor with Z q = 0. 7 produce essentially 
independent estimates of position and velocity every 10 seconds. Figures 
4-1 and 4-2 further indicate that the confidence of the estimates from 
either filter will be about the same. 


Since the radar servo bandwidth is 8 cps, the radar samples at 
once per second are uncorrelated. 
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Figure 4-5 Velocity/ Position Estimates Normalized Crosscorrelation 



From the preceeding, it is obvious that as Z q is varied to adjust the 
noise power reduction/b|as error growth, the time between updates must 
be adjusted accordingly to assure that the estimates of position and velocity 
supplied to the mixing filter are essentially uncorrelated, e. g. , for Z q = 0. 9, 
nT should be on the order of 30. This nT corresponds to the MDIU quantity 
"NTMAX. " 

Preprocessor Filter Implementation 

The preprocessor, as implementated in Phase IB equations, is 
shown in block diagram form in Figure 4-6. It differs from equations 

A 

Estimated 
Velocity 

Smoothed 
Position 


Figure 4-6 Preprocessor Filter 

(4-1). through (4-4) only by the R term which is necessary for the follow- 
ing reasons. The filter is designed to recognize the average linear motion 
of the vehicle; thus, the presence of any acceleration must be accounted 
for. This is accomplished by subtracting the second integral of the total 
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acceleration (R^) from the radar data such that, in the presence of no 

onboard system errors, the difference between the predicted and measured 

linear motion is due to radar noise. 

In equation form this may be described as follows. The radar 

measurements (R ) may be modeled as 

t 

(4-7) (t) = R -{■ R t + JJ 1 R (t) dt + noise (t) 

o 

00 

where R c (t) is the vehicle accelerations in the navigation frame and is due 

primarily to buffeting. Since the preprocessor is designed to recognize 

linear motion, the buffeting term must be removed from the filter input. 

This is accomplished by computing the second integral of total acceleration 

as seen by the onboard navigation system, i. e. , that measured by the IMU 

plus centripetal, coriolis, and gravity as computed by the navigation 

equations. This ESF frame acceleration may be expressed as the correct 

value plus any IMU induced error. Therefore, 
t • t 

(4-S) R cc (t) = JJR C < t) dt + JJ’AR.tt) dt 

o o 

The input to the preprocess filter (R^) is then 

t _ 

(4-9) R (t) = R + R t + noise (t) - f C AR (t) dt 

r o o c 

o 

An approximate value of aR^ can be computed (for rough analysis 
purposes only) from Equation (4-10) where the transformation matrix is. 
treated as unity. 
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(4-10) 


A*R Ab + g (a Vi + A yt) 

C 

where Ab, and Ay are the bias, platform misalignment and platform 

drift rate errors respectively. Using the specified one sigma values of 

-4 

10 g's, 30 arc seconds and 0. 1 degree/hour, after 2000 seconds of 
navigation AR^— 0. 04 feet/second . Using this value of acceleration 
error. Figure 4-7 gives the optimal value of for a one .sigma noise of 
both two feet and ten feet. The optimal value for Z^ is that which minimizes 
the sum of the squares of the velocity error due to radar noise and the 
velocity error due to AR c - 

As seen from this figure, the optimal value for Z is 0. 825 and 0. 7 • 
for a one sigma radar noise of two and ten feet respectively. NTMAX for 
= 0. 7 should be 10 or greater and 20 or greater for Z^ = 0. 825 as 
determined from Figures 4. 1, 4. 2, and 4. 3. Figure 4-7 further illustrates 
an important consideration, that too much filtering may actually be 
detrimental when modeling errors are present. 

* • 

A second order filter, one which estimates AR , could be imple- 

c 

mented which would do much to eliminate this problem. In fact, this is 
precisely what IBM recommended during the Phase 1C studies. The 
penalty for the second order filter is not significant with respect to 
computational loading but is with respect to the update cycle. As IBM 
Report Number 69-NC7-024 indicates, to achieve the same confidence in 
the velocity estimate, as for the first order filter, the data span would 
have to be increased by approximately a factor of two. 
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When the update mode is first initiated, the preprocessor position 
and velocity should be initialized with sufficient accuracy that an overly 
large trdhsient does not occur. The radar position data is considerably 
better than the IMU position data, but the confidence level of the velocity 
data was a toss-up based on the original radar noise /IMU error models. 
Therefore, the preprocessor velocity is initialized with the existing 
navigation velocity, and the position is initialized by a least squares five 
point fit to the first five radar measurements processed by the computer. 

When the measurement noise model is not well known or changes 

i 

for various flight tests, the filter gains and smoothing times must be 
altered accordingly.' The simplicity of the preprocessor is thus a very 
desirable feature. For example, if the bias error proves to be small, 
longer smoothing times (which implies a larger Z q ) may be used to 
achieve a greater noise power reduction. Such a change requires only 
two program constants to be changed via the MDIU; i. e. , the update 
interval (NTMAX) and Z . This simplicity and the resulting short compute! 
execution time were of particular significance during the equation develop- 
ment phase when sizing results indicated alternate approaches required 
excessive computation time on the Gemini computer. 

Mixing Filter 

The mixing (update) filter combines the estimates of position and velocity, 
computed by the preprocessor filter, with the existing onboard navigation 
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values. The filter weights are prestored constants since, as previously- 
stated, the Gemini computer does not have sufficient computational capa- 
bility for real time solution. 

Either of two mixing filters may be chosen, a six/ nine state filter 
or the "Koenke 11 filter. The six/nine state filter has the option of updating 
position and velocity only (six state), or to also compute platform drift 
correction or platform misalignment correction (nine state). The software 

i 

allows ten sets of gains (540 constants) to be pre stored. If updating is 
allowed to continue beyond ten times, the six state continues to use the 
tenth gain set over and over. In the case of platform corrections, after 
the last gain set has been used, the nine state filter is reduced to a six 
state. 

The Koenke filter replaces the onboard navigation quantities with the 
estimates of position and velocity, obtained from the processed radar data, 
at the first update; and thereafter, equally weights, the estimates and the 
existing navigation- quantities. This filter has advantages, be sides its 
inherent simplicity. Since the weights are constant (after the first update) 
the problem of radar, dropouts, and subsequent incorrect weightings, is 
eliminated. The gains for the Koenke filter and an optimal filter are 
almost identical for the first two times where the greatest increase in 
system accuracy is achieved. While the Koenke filter tends to restrict 
the growth of errors during the update period, the optimal filter tends to 
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also decrease their rate of growth. However, this decrease may be of 
little significance; and when problems such as radar dropouts are considered, 
the optimal approach could actually be inferior. 
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Section 5 


SOFTWARE DEVELOPMENT 

The equations discussed in the preceeding sections are presented in 
system math flow’ form in Appendix C. This is the final Revision B level 
of the V/STOL Phase IB software. The resulting Gemini computer pro- 
gram uses 8, 865 of the 12, 288 thirteen (13) bit memory -locations, and 
requires approximately 0. 7 seconds execution time per' cycle with the 
Koenke mixing filter option. The basic computer computation cycle is 
executed at one second intervals, the same as the radar data transmission 
rate. This computation cycle execution is controlled via software as the 
Gemini computer does not have interrupt hardware. 

The input data required by the program is contained in Tables D-l 
and D-2 in Appendix D. Those in Table D-l are entered via the up-link, 
i. e. , the digital command system (DCS), and those in Table- D-2 are 
entered via the manual data insertion unit (MDIU) prior to flight. For 
those input quantities which require more accuracy then can be obtained 
through the five character length MDIU, the "write any word" option may 
be used. This option' allows any location in memory to be loaded by three 
consecutive MDIU operations which provides the full 25 bit data word 
accuracy. 
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The simplified flov/ diagram in Figure 5-1 summarizes program 
execution of the major events. A typical sequence of actions required to 
exercise the software are: 

Prior to liftoff: 

• Computer power on. 

• Set mode switch to preflight. 

• Load and/or verify input data via MDIU. 

• Set mode switch to flight - this initiates cruise frame 
navigation initialization. 

• Press start comp button - Upon recognition the 
computer turns on computer running light, frees 
platform and begins navigation. 

After liftoff: 

• Set LCAN negative via DCS - this initiates approach 
frame navigation. 

• .Set LCUD negative via DCS - this initiates execution 

of the up-date equations. 

• Set LCUD positive via DCS - this terminates updating 
and the system continues inertial navigation in the 
approach frame. 
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Figure 5-1 Simplified Functional Flow 
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The radar update option may be switched in and out at the users discretion 
simply by transmitting the proper LCUD command. Once LOAN is set 
negative, however, navigation is locked in the approach frame. 

Equation/Program Verification 

The number and complexity of the equations dictates simulation as 
the primary verification tool. This is done at two levels, the Fortran 
level and the operational program level, , the latter providing a bit by bit 
comparison to the actual Gemini computer execution. 

The simulation programs .are implementated as indicated in Figure 
5-2, where only the navigation portion is shown. The lower half of the 
figure is the actual navigation equation mechanization as derived in 
Appendix A (Figure A-4); and the upper half simulates the accelerations 
that the inertial platform experiences. The reference accelerations are 
defined in the navigation frame and the resulting accelerations in the 
platform frame are computed. The reference accelerations may be 
redefined as a function of time to allow simulation of realistic flight 
profiles. By evaluating the exact integrals of the acceleration forcing 
function, which is specified in the earth surface fixed frame, reference 
solutions for position and velocity are obtained. This approach allows 
accurate evaluation of computational/mechanization errors. For example, 
one of the options replaces the spherical earth gravity model in the 
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Figure 5.-2 System Simulation. Implementation 
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forcing function with a very accurate obtate spheroid model, thus, 
providing a measure of the accuracy of the navigation model used. The 
exact integrals of the reference acceleration are also used to simulate 
the radar updates transmitted to the navigation system. 

Typical Fortran simulation results are shown in Figures 5-3 
through 5-6. These results shown mechanization and computational 
errors only, i. e. , a perfect IMU. The flight profile is plotted in Figure 
5-3. The vehicle accelerates for ten seconds to a vertical velocity (Z^) 
of ten feet per second and a down range velocity (X^) of 100 feet/ second. 
This constant velocity is held to an altitude of 500 feet where the vertical 
velocity is reduced to zero. After 200 seconds of flight, navigation is 
switched to the approach frame. 

At 200 seconds the position errors before and after' switching to 
approach are: 



Cruise 

Approach 

AX c 

0. 5 feet 

-1.1 feet 

AY 

-. 9 feet 

-15.5 feet 

c 


AZ 

34. 4 feet 

14. 0 feet 


c 


The error build up prior to frame change is totally due to mechanization 
and computation which is performed in floating point, single precision 
on the IBM 360-50 computer. The frame change errors result from 
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Figure 5-4 X Channel Velocity Error 
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Figure 5-6 Z Channel Velocity Error 
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truncation due to the large numbers (earth 1 s radii) required for the 
transformation. 

As shown in Figure 5-3, buffeting is introduced at 210 seconds with 
a slow frequency large amplitude sine wave in the vertical channel, and 
high frequency smaller amplitude sine wave in the horizontal channel. The 
first update at 235 seconds removes essentially all the accrued error. The 
updates continue at ten second intervals with Z being set equal to 0. 7. 

The plots in Figures 5-4, 5-5, and 5-6 show the velocity error 

growths and the update corrections. The erratic behavior of the y channel 

updates is due primarily to the error resulting from the integration 

algorithm used to compute R for the preprocessor. (The integration 

c c 

algorithm assumes a constant acceleration over the one second computa- 
tion cycle. ) Since it does not accurately integrate the high frequency sine 
wave buffeting,, a component of acceleration is allowed to enter the 
preprocessor filter which is designed to recognize only linear motion. 

The z channel bias offset of about 0. 05 fps is also due primarily to the 
integration algorithm error. 

After completing the Fortran simulation level verification, the 
Gemini computer instructions are simulated via the operational program 
simulator. The primary difference between the two should be a slight 
loss of accuracy due to the Gemini computer's fixed point arithmetic. 
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A typical comparison of results is shown in Figure 5-7 for a thousand 
seconds of stationary navigation, where the operational simulation error 
growth is Slightly faster. The dominate error source for this case is the 
simulated quantization (0. 1 feet/second) of the accelerometer outputs. 

This is illustrated by the short time history of x channel velocity in 
Figure 5-8. 

The final program verification is performed using the Gemini 
computer itself. The flight software includes a self-test feature, controlled 
by MDIU insertable logical choices, which exercises essentially all of the 
program loops without the necessity of tying the computer into the other 
flight system hardware. The results are verified by comparisons to the 
previously generated simulation results. 

This final program checkout is actually accomplished in three levels; 
the first two utilizing the self-test feature. These levels are: 

Level 1: This test, which checks computer and software only, has 

completely repeatable results which compare bit by bit to 
the operational simulation results. This is possible 
because the self-test program generates its own accel- 
erometer data and fixes the computation cycle to exactly 
one second. 

Level 2: The software "fixed" computation cycle is included in the 

program execution. Since the software computation cycle 
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\ 

control Results in slightly asynchronous operation, this 
test assures that the deviations are insignificant. 

Level 3: Acceleration data is generated by the AGE equipment 

which allows testing of the interface as well' as the 
operational software. 

The self-test feature has the additional advantage that the program 
can be rechecked at any time in the field. 
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Section 6 

POST FLIGHT ANALYSIS 

Post flight analysis was necessarily limited by the small amount of 
data supplied; i. e. , a partial data set for each of two flights. Its fragmented 
nature further hindered the analysis because of the limited number of 
continuous blocks spanning a sufficient time interval, e. g. , 200 seconds. 

Of primary interest was the accuracy of the velocity update and the 
radar noise model. An indication of the radar noise may be obtained from 
the prepr.ocessor AR, the three elements of which were telemetered down 
and recorded at IBM's request. 

As defined in Section 4, 

(6-1) R = R - R = radar value - predicted radar value 

r p 

where 

. /\ ^ 

(6-2) R = R + TR = previous estimate of position + velocity estimate 

P 

times T 

2 

The variance of AR is obtained by computing the expectation of AR 
which gives 

,/ 2 2 2 2 2 Tjr 
(6-3) o" ~ cr + cr e + T + 2T K c cr 

AR r r r R 


cr* 

R 


6-1 



where K is the correlation coefficient given in Figure 4-5. For Z =0.7, 
c o 

= . 039, and referring to Figures 4-1 and 4-2 OH* — 0- 62 CT^ and 

r 

CTt - o- 1 <T_ . Substituting into equation (6-3) yields 

£\. „ IX 

r 

(6-4) <r^ R - 1.40 0-2 or<r R =0.85 CT R 

r r 

Before analyzing the recorded DAS data, which is transmitted -at 2. 4 
second intervals, linear extropolation was used to reconstruct a sequence 
with uniform one second intervals. This was performed on the data supplied 
for flight number B2-03. The standard deviations and normalized auto- 
correlations for the preprocessor AR were computed and the results are 
shown in Figures 6-1, 6-2, and 6-3. These are based on 150 seconds of 
data recorded during the approach update phase. The autocorrelation was 

computed from equation 6-5. 

150 

,6 - 5 > ■155.2 ax.(t) ax.(t + r) 

1=1 

The largest standard deviation ( Qf ) is about 2. 5 feet. According 
to Equation 6-4, the radar noise -then has. a standard deviation on the order 
of two feet, which is much smaller then originally anticipated. These 
results are fairly well verified by the plots of velocity after touchdown 
shown in Figure 6-4. Since the system is performing stationary navi- 
gation, the ideal velocity is zero. The actual velocities, although biased 
off by the IMU errors, indicates an update accuracy on the order of that 
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Figure 6-1 Normalized Autocorrelation for Preprocessor A~K 
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Figure 6-3 Normalized Autocorrelation for Preprocessor AZ 



sec 



6-6 


predicted by Figure 4-2 for the above radar noise model,, i. e. , approximately 
0. 2 fps. . ' 

‘The plots in figures 6-5, 6-6, and 6-7 are from data supplied for a 
case where the system is being updated while performing stationary 
navigation on the pad after 2000 seconds of flight. The only noise is that 
due to the IMU and occasional quantization jumps in the. radar data. It 
thus provides a good demonstration of the preprocessor operation. 
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Figure 6-5. X Channel Stationary Navigation Quantities 
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Figure 6-6. Y Channel Stationary Navigation Quantities 
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Figure 6-7. Z Channel Stationary Navigation -Quantities 
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Appendix A 


NAVIGATION EQUATIONS DERIVATION 


As described in Section 3, navigation is performed in either of two 

earth- surface -fixed rectangular coordinate frames; the cruise frame with 

its origin at the liftoff point, or the approach frame with its origin at the 

touchdown point. The inertial platform and cruise navigation axes are 

indicated in Figure A-l. At liftoff {t = 0) the origins of the platform frame 

(X , Y , Z ) and the navigation frame (X , Y , Z ) are coincident. The 
p p p & c c , 

platform axes are nominally aligned North, East and down (plumb bob 
vertical); however, as shown in Figure A-l, any arbitrary azimuth angle 
( <y^) is equally acceptable. The navigation frames are nominally aligned 
North, East, and up (plumb bob vertical), and either or both may also be 
aligned at arbitrary azimuth angles with respect to the North-East nominal. 
A positive azimuth is always defined as a positive rotation about the axis 
along the plump bob vertical of the frame. 

With proper initialization, the same equations apply equally to either 
navigation frame. Therefore, no distinction, as to cruise or approach, is 
necessary in the ensuing derivation. Referring to Figure A-l, the following 


reference frames may be defined. 


A-l 






X 


(A-l) R = Y Earth Centered Inertial 

Z 


X 

e 

(A- 2) R = Y Earth Centered Fixed 

e e 

Z 

e 


X 

s 

(A-3) R = Y 
s s 

Z 

S3 


X 

c 

(A-4) R = Y Geodetic Earth Surface Fixed 

c c 

Z 

c 

Also define 

0 

(A-5) H = 0 Altitude of R Frame Origin Above 

h Reference Spheroid 

and 

cos q> 

(A-6) R = p 0 

P s 

sin cf> 


Geocentric Earth (Reference Spheroid) 
Surface Fixed 
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The following matrix relationships may now be defined. 

(A-7) R = N R 

e 

where N = f (0) 

(A-8) R = M (R - R ) 

s e p 

where M = f (<j> ) = constant matrix 

(A-9) R = L R - H 

c s 

where L = f (e, o() = constant matrix 

Combining Equations (A-7), (A-8), and (A-9) 

(A- 10) R = -H - L M R + LMN R 

c p 

Differentiating Equation (A- 10) twice 
(A-ll) R c = L M (N R + N R) 

(A- 12) R =LM(NR+2NR + NR) 

c 

From Equation (A- 10) 

(A-13) R = N T (R + M T L T (R +H)) 

P c 

and from Equations (A-ll) and (A-13) 

(A- 14) R = N T M T L T R - N T N N T (R + M T L T (R +H)) 

c pc 

Substituting (A-13) and (A- 14) into (A- 12) 

(A-15) R = L M (NN T -2(NN T ) 2 (R + M T L T (R + H)) 

C p c 

• T T T • •• 

+ 2 N N MLR + N R) 
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Equation (A- 15) may be simplified as follows 


(A-16) 


cos 9 sin 0 0 


N = 


-sin 0 cos 0 0 


0 0 1 


Where © = co t 
e 


Differentiating N and defining the V operator 

N 2 -co 

e 

Differentiating again 
(A- 18) N = -w V N = V 2 N 

Substituting (A-17) and (A-18) into (A-15) yields 


(A- 17) 



sin 0 

-cos 0 

0 


0 

-1 

0 

N = -co 

cos 0 

sin 0 

0 

= -w 

1 

0 

0 

e 

0 

0 

0 

e 

0 

0 

0 


(A- 19) R =LM ( -c o 2 V 2 (R + M T L T (R + H)) 

c e p c 

rp rp 

-2co V M L R + N R) 
e c 

Further simplifications are possible from the following identities. 




-1 

0 

0 


-1 

0 

0 


0 

0 

.0 

(A- 20) 

2 

. V = 

0 

-1 

0 

- 

0 

-1 

0 

+ 

0 

0 

0 



0 

0 

0 


0 

0 

-1 


0 

0 

1 


= -1 + 6 
Therefore, 

(A- 21) LM 57 2 (LM) T = -I + DM 5 (LM) T 


V N 
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and defining 




d ll 

d 12 

d 13 

(A-22) 

LM = 

d 21 

d 22 

d 23 



d 31 

d 32 

d 33 


then 


(A- 23.) 


LM 5 (LM) = 


13 


d 23 d 13 d 33 d 13 


d,, d„„ d_„ 

13 23 23 


d 33 d 23 


d 13 d 33 d 23 d 33 d 33 


and 


(A- 24) 


LM V (LM) = 


With the following definitions 


(A- 25) 

D = LM 

(A-26) 

A = -I + D 5 D 

(A-27) 

B = D V 2 

(A-28) 

C = D S7 D T 


Equation (A- 19) may be rewritten as 



d 

- d 

d 

11 

22 

12 

21 


d 

- d 

d \ 

11 

32 

12 

31 


d 12 d 21- d ll d 22 1 d 12 d 31 - d ll d 32 


d„ , d..^ d„ , d„ _ 

31 22 21 32 


(A-29) R = -co (BR + A (R + H)) 

c e p c 


- 2oo CR -f D N R 
e c 
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The elements of the matrix N have been previously defined. It can be 
readily shown that the elements of the remaining matrices in Equation 
(A-29) are the following. 




cos^ A- 

• 2 
sin o( 

-1 

cos^A 

COS<X 

sine* cos A sin A 

sin c* 

(A-30) 

A = 

cos^ A 

cos o( 

sint* j 

cos^A 

2 

COS c< 

-1 cosA sinA 

j 

' cos-o( 



cos A 

sin c< 

1 

smcx j 

COS A 


sinA 

z \ 

cos°< j -cos A 




sin A 

sine* 

-cose* 

0 





(A-31) 

B = 

sin > 

coso( j 

sin 0< 1 

0 







-cosA 


0 i 
1 

0 







° 

-sin A 


1 

cosA 

COS D< 


(A-32) 

C = 

sin A 


0 


1 

-cosA 

sin cC 




-cos A 

cos o< 

cosA 

sin<v 

1 

1 

0 





-sinA 

sin 

cos C>< 

| COE 


sine* 



(A-33) 

D = 

-sin A 

cos <X | 

1 

i -sin<x 

^ COE 

1 

»A 

COS C* 





cosA 


0 

| -sinA 





The first and second terms of Equation (A-29) are the familiar 
expressions for centripetal and coriolis accelerations respectively. The 
remaining term, the system forcing function, is composed of the measured 
and gravitational accelerations. In the ECI frame this may be expressed 
as 
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• (A-34) 


DN R = DN (R + R ) 

' m ' g' 

The gravity computation for this application can be accomplished with 
sufficient accuracy by choosing an "equivalent" spherical earth model; 
the computational frame for which is indicated in Figure A- 2. Since the 
gravity computation is now independent of longitude, Equation (A-34) may 
be rewritten as 


(A-35) D N R - D N R +DR 

m g 

where 

(A-36) O R = D <~) R 

R 

i g! 


and 


(A-37) R = D' p + D T R 

1 ' g o c 

where D'” = f (A ) = constant matrix 
g 

Equation (A-36) exhibits the well known vertical channel instability. For 
this application a more desirable solution, which is bounded, can be obtained 
by setting 


(A-38) 


-GM 




= constant 


then 

G G 

(A-39) DR = -G DD' — R = -G — R 

go p c c p c 

& r o r o 
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■Figure A-2 Gravity Computation Frame 



Figure A- 3 Ideal Mechanization 


A-9 








It is easily shown that 


-sin c< sin e 


G = G -cost*' sin e 
co g 


cos e 


As indicated in Figure A~l, the inertial platform is aligned to the 

local vertical at some arbitrary azimuth. Therefore, 

R = P R 
m p 

where 


(A-4Z) 


;in A sin c^p -cosA -sin A cos ‘A 


P = cos A p 


sin of p 


\ \ 

-cosA sinAp -sin A | cos A cos A] 


(A-43) 


** * * 
R = Y 

P P 


(Ideal accelerometer outputs) 


Introducing Equations (A-35), (A-39), and (A-41) into Equation (A-29), the 
final equation becomes 

G 

(A-44) R = -co 2 (B R + A (R .+ H)) - 2co C R - G - — R + D N P R 

ce p c eccp^c p 


This is shown in block diagram form in Figure A-3. 
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The equation mechanization shown in Figure A-3 is obviously an 


idealized version. The ^.ctual accelerometer outputs are increments in 
velocity, and the digital Implementation introduces a transport lag in the 
feedback loops. To offset the error due to this feedback delay, a predictor 
corrector type integration algorithm is used. The algorithm is derived by 
assuming a constant acceleration over the integration interval. That is 

(A-45) R^ = constant, ((nT - T) < t < nT) 

nT 

(A-46) R (nT) = f R d t + R (nT - T) = R T + R (nT - T) 

C nT-T ° c c 

nT 

(A-47) R (nT) = [ (R t + R (nT - T) ) dt + R (nT - T) 

nT-T C 


= R (T /2) + R (nT - T) T + R (nT - T) 
c c c 


However, 

(A-48) R T = AR = AR / + R T 

c c p s 

where 

AR^ = accelerometer outputs in the navigation frame 

and 

R = summation of computed accelerations due to gravity, 
s 

centripetal, and coriolis 

Since R is treated as a constant over the interval, a reasonable approach 
s 

is to compute its value at the midpoint of the interval. For the computation 
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of centripetal and gravitational accelerations, this requires predicting the 
value R forward one -half computation cycle. The most straight forward 
method is 

(A-49) R cp = R c (nT - T) + (nT - T) ~ 

The error, due to the transport lag, in the c.omputation of coriol-is 
acceleration is of sufficiently small magnitude that it is ignored. 

The block diagram representation may now be redrawn as shown in 
Figure A-4. It is of interest to note that the integration algorithm previously 
derived is the familiar form of trapezoidal integration; which in Z transform 
notation is (T/2) ( (Z+1)/(Z-1) ). Trapezoidal integration has perfect phase 
of -90 degrees (the same as an ideal integator). Therefore, without the 
predictor corrector, the solution of the closed loop system is unstable 
(closed loop poles outside the unit circle) due to the phase lag introduced 
by the feedback delay (1/Z).. This phase lag as a function of frequency is 
shown in Figure A- 5. 

The predictor corrector modifies the overall position loop such that 
it is equivalent, from the standpoint of phase, to replacing the trapezoidal 
integrators with forward rectangular; yet the more accurate trapezoidal 
algorithm is retained in the forward loop. The advantage is that forward 
rectangular integration, which in Z transform notation is ZT/(Z-1), 
introduces phase lead into the system; and as can be seen from the phase 
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characteristic shown in Figure A~6, two forward rectangular integrators 
provide exactly the phase lead required to offset the phase lag of the feed 
back delay. 

One further correction is required. With an ideal mechanization, 
the accelerometer outputs in the rotating navigation frame are 
nT 

(A-50) Aj C,r = f D N P R dt 

nT-T P 

But the physically realizable implementation gives 

nT 

(A-51) 4R' = DNP f R dt 

P . nT-T P 


where 


nT 


{ A-52) 


I 


R dt = AR = accelerometer outputs 


nT-T 


Thus the error is 


(A-53) 

€ = 

-a r' = d( 

f nT 

f NPR dt-NP 

nT \ 

f R dt) 

PI 

P \ 

J p 

V nT-t F 

nT-T P / 


where 



COS (cO^t) 

sin (oo^t) 

0 


1 

CO t 

e 

0 

N = 

-sin (co t) 
3 

cos (co t) 
e 

0 

Cl 

— CO t 

e 

1 

0 


0 

0 

1 


0 

0 

1 


= I + co t V 
e 
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where 


0 10 


V = -1 0 0 


0 0 0 


Thus 


(A-54) NP - P + cotVP 

e 


(A-55) e = -to DVPJJ R dtdt 

nT-T p 


If R 


The corrected navigation frame values are then 


ij. J. 

(A-56) R =D ( (P + b t 7 P) J R 

P V e _ ^ ^ : 


nT-T 


dt - to S7 P // R dt dt ) 
e nT-T P ' 


Treating R as a constant over the interval 
P 

(A-57) A = D (I+co ( t - J) PAR 

p v e 2 ' p 

T 

But (I + (t - — )V) is nothing more then the first order approximation 
of the N matrix evaluated one -half computation cycle behind. The obvious 
correction is simply to evaluate the N matrix using Equation (A-58). 


(A-58) 


8 = r> 


A- 15 



Appendix B 


PREPROCESSOR FILTER DERIVATION 

The following derivation of a recursive exponentially weighted least 
squares filter is similar to that for classic least squares. Figure B-l 
illustrates fitting a linear function of time to redundant measurements, 
where 

* 

X is the measurement, 

X is the estimate of x based on n measurements, 
n 

❖ 

X is the estimate of x based on n measurements, 
n 



B-l 


Note that the estimates ^.re for the end point (latest time). Solution of the 
curve fitting process by classic least squares is obtained by minimizing 
Equation (B-1), which is the sum of the squares of the residuals of all 
measurements . 

? n * A * 2 
(B-l) e =5? (X . - (X - i T X )) 

r—* n-i n n 

1=0 

This obviously results in an infinite memory filter with equal weighting for 
all residuals. Thus for classic least squares, a finite memory filter can 
only be achieved by limiting n which precludes a recursive formulation. 

By introducing an exponential weighting factor the infinite memory 
filter can in effect be reduced to a finite memory filter, without limiting 
the value of n. For the exponentially weighted case, Equation (B-l) is 
redefined as 

(B-2) = (X*.'-(X - i T X )) 2 Z 1 

n-i n no 

1=0 

where 

(B-3) zJ ) =(e" T/ ^) 1 

where •y is the filter time constant. Equation (B-2) places the emphasis on 
the more recent data by exponentially weighting out the older residuals; 
which in effect achieves the finite memory. It now remains to derive the 
recursive formulation. 

To minimize Equation (B-2), Equations (B-4) and (B-5) must be 
satisfied. 


B-2 



(B-4) 


2 n 


\ A * — 1 

X i=o 
n 


= (X'" . - (X - i T X )) Z 1 = 0 

n-i n no 


(B-5) 




2 n 


V 'S'k ~ 

d X i=o 

n 


= < i (X'“ . - (X - i T X )) Z 1 = 0 
t-* n-i n n o 


Equations (B-4) and (B-5) may be rewritten in matrix form as 
n 

4 X . Z 
4- 1 n-i o 


(B-6) 


1=0 


n 


£ ix .z 

r -1 n-i o 


1 = 0 


1 = 0 


i=0 


n 


i=o 1 1=0 


i 


A 

i Z 


X 

o 


n 

2 i 


/£- 

i Z 


TX 

o 


n 


Using Abel’s summation equation, it can be shown that 

, n+1 


(B-7) 

«NKi.S 

it 

(B-8) 

n 

b = ^ 

n r-* 

1 = 0 

(B-9) 

n 

c = 
n ^ 

1 = 0 


° <-v 2 


(1 - (n + 1) Z n + n Z n+1 ) 
o o 


.2 _i 
l Z = 
o 


(i - z o > 


T (1 + Z - Z n ((n + l) 2 - (2n 2 4 
3 o o 


Z + n 2 Z' 
o ( 


With the above definitions. Equation (B-6) may be rewritten as 


(B- 10) 


n & ; 

^ X . Z 
f- 1 n-i o 

1=0 


a 

n 

-b 

n . 


X 

n 

n 

* i 

£ iX . Z 
4- 1 n-i o 

1=0 


b 

n 

-c 

n 


TX 

n 


2n - 1) 

)) 


B-3 



Solving for the estimates 






-1 

A 

x 

n 


a 

n 

~b 

n 


TX 

n 


b 

n 

-c 

n 



^ * 1 

A B £ X . Z 
n n . n-i o 

1=0 


! TX b -c £, i X . Z -B c £ iX . Z 

I n I In n l I n-i o’ n n f 1 n-i o 

1=0 1=0 

With proper algebraic manipulation, it can be shown that 

(1-Z 2 ) - ((n+1) 2 - n (3n+4) Z q + (3n 2 +2n-l) Z 2 - n 2 ZJ 

n 1 - Z n {(n+1) 2 - 2n (n+2) Z + (n+1) 2 Z 2 ) + Z 2{n+1) 
o o o o 

-(1-Z ) + Z n ((n+1) - (3n + 2) Z + (3n+l) Z - n Z ) 

_ 1 o o " ' ' o o o' 

n 1 - Z n ((n+1) 2 - 2n (n+2) Z + (n+1) 2 Z 2 ) + Z 2(n+1) 
o o o' o 

- ( 1 - Z ) 3 + Z n+i (l-z 3 ) 

. c _ O o O 

n Z (1 - Z n {(n+1) 2 - 2n (n+2) Z + (n+1) 2 Z 2 )- + Z 2(n+1) ) 
o O O O o 

Before proceeding further, the summations in Equation (B-ll) must 

be eliminated. Rewriting them in terms of their past values. 


* ii* w 

< x .z=x+z £ x , . z 

. n-i o n o " n-l-i o 


n ^ . / n- 1 n-1 ^ 

< i x n< . z 1 = Z ( X . Z 1 + £ i x" . z 1 
-r J n-i o o \ +— J n-l-i o n-l-i o 

1=0 \ 1=0 1=0 


Substituting Equations (B-15) and (B-16) into (B-ll) 


B-4 



< B — 1 7 ) 


ys 

X 

n 


/s 

TX 

n 

ti 

N 

o 


(A + B ) B 
n n n 


{C - B ) C 

n n n 


n- 1 


1=0 


n- 1 


1=0 


. z 1 


A 

-1 o 


n 

1 • zl 

+ 

-B 

1-1 o 


n 


X 


n 


and from Equation (B-10) 

n ~ 1 A 

1L x z 1 

f— 1 n-l-i o 

1=0 


{B- 18) 


n- 1 

4 x X , . Z 
n-l-i o 


1 = 0 


n-1 


n-1 


-b 


n-1 


-c 


n-1 


A 

X 


n- 1 


❖ 

TX 


n-1 


Combining Equations (B-17) and (B-18) 


(B-19) 


A 

X 

n 

= Z 

'> 

TX 

n 

o 


a (A +B ) -f b B 
n-1 n n n-1 n 


-b (A +B ) -c B 
n-1 n n n-1 n 


a (C -B ) + b . C 1 -b (C -B ) -c . C 
n-1 n n n-1 n n-1 n n n-1 n 


n- 1 


'S' 

TX 


n-1 


+ 


A 


n 

-B 


X 


n 


With proper substitutions and manipulations, Equation (B-19) may be reduced 
to 


X 

n 



A 

X 

n 


U-Kj) 

(1-Kj) 


Ax 

X i 

n- 1 


K i 

(B-20) 

'S- 

- 





*1* 



TX 

n 


- K 2 

U-k 2 ) 


TX , 
n- 1 


K 2 


where 


(B-21) K = A 

1 n 


and 


(B-22) K = -B 

2 n 


B-5 



The above recursive relationship may be rewritten in the following 


more familar form. 

(B-23) X = X + K. (X* - X ) 

n p 1 n p 

(B- 24) TX = TX + K_ (X* - X ) 

n n-1 2 n p 

where 

(B-25) X = X . + TX . 

p n-1 n-I 

K. and K_ are functions of n and Z , and are restated in Equations (B-26) 
12 o 

and (B-27.) for the exponentially weighted least squares case. 


(B-26) 


K l = 


(1-Z ) - Z n ((n+1) - n (3n+4) Z + (3n +2n-l) Z - n Z ) 

0 o v ' o o o_ 

1 - Z n ((n+1) 2 - 2n (n+2) Z + (n+1) 2 Z 2 ) + Z 2(n+1 * 

o o o' o 


(0 ^ Z Q 1) 

O 9 *3 

(1-Z ) - Z n ((n+1) - (3n+2) Z + (3n+l) Z - n Z ) 

(B-27) K = 2 2 ? r — 2 rr-—, (0 <; Z < 1) 

2 1 - Z n ((n+1) 2 - 2n (n+2) Z + (n+1) 2 Z 2 ) + Z Z ^ n+ * 

o o o' o 

By evaluating the above expressions for Z^ = 1, the gains for classic 


least squares are obtained. They are 


(B-28) 



_ 2 ( 2n+ 1 ) 

]l (n+1) (n+2) 



6 

(n+1) (n+2) 


B-6 



The final consideration is the case for large n, which yields the 
preprocessor filter discussed in Section 4. As n approachs infinity. 
Equations (B-26) and (B-27) reduce to 

(B-30) K = 1 - Z 2 

t o 

n & 

(B-3 1) K =(1-ZJ 2 

o 

n -*■ <a=> 

The rate of convergence of the gains as a function of n, for various Z 

values, are plotted in Figures B-2 and B-3. Convergence requires about 

four time constants; i. e. , the time required to clear the initial transient. 

Of more interest are the curves plotted in Figures B-4 through B-7. 

These show the ratio of the standard deviation of the estimates to the 

standard deviation of the measurements for Z equal to 0. 7 and 0. 9. As 

o 

would be expected, under steady-state conditions the results are identical. 

While the previous curves indicate the desirability of a long memory 
filter to reduce to noise power, the value of the finite memory is illustrated 
in Figures B-8 through B-ll. These curves show the error in the estimate 
resulting from acceleration, which the first order filter is not designed to 
recognize. 
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Figure B-2 Exponentionally Weighted Least Squares Position Gain 







01 - 



'• Figure B-4 
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Figure B-6 Ratio of Standard Deviations of Position Estimate 

to Measurement (Z Q = 0. 9) 



Figure B-7 Ratio of Standard Deviations of Velocity Estimate 

to Measurement (Z Q = 0. 9) 
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Figure B-8 Error in Position Estimate Due to Constant 

Acceleration Input (Z'q = 0. 7) 
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Figure B-9 Error in Velocity Estimate Due to Constant 

Acceleration Input (Z Q = 0. 7) 
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Figure B-ll Error in Velocity Estimate Due to Constant 

Acceleration Input (Z Q = 0. 9) 



Appendix C 

SYSTEM MATH FLOW 

The system math flow contained in this Appendix is the final Revision 
B level for the Phase IB software. A math flow symbol definition list is 
contained at the back of the appendix. 


C-l 


























(x u 4) 

F'yi 


F-*s &tc 
Py.S A tc. 


C Xus ) = f X2 - Km A 

Fy ~ Kyi ~ Ky A A AaELggomeree coae,-eLTtow 

F * = F it ~ Ki4 A t c 


F* 


Fy 

- 

F* 



K*i K*<> Kx3 
^Yl Ky2 Ky3 
K&I K 2^ K^ 2 
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Cx//7; <:~o = J* x 

<e£y ^"0 “ c^y 

■£ b C-0 ~ cT z 

y 

Cx//3) <aT* — —Qx&tf U S y Kx + tJjrx F £ + x 6~0 
Sy ■= -QyAZ- U$ Y f y * U zy F £■ ^ °fy 6~l) 
gT £ - — Ux z f~ x z C~0 


/ ~ <sf 2 ofy Fx 

o^t I ~Sk Fy 

“ S Y *S X / F 2 
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uem£ No, 


5AV^ * 5 AV< + A (x/2o) 

$AVy a 5AVy + A V> 

^av 2 = 5av 2 + a kp 

y SL-Zts /zX 


(XI2/./) A/.5TS =2 


Xn^i22) 

Nlc/Nt^ y 

x?- 

Xxxtzs) 


/? IpPXOGCtf A/W 
Ini T/Al. I2f=> TION 


At 2 ~ <C- 5 ' A r c (x/ 34 ) 


<£? — 0J& (t~2lt 2 ) ^ AS> (X.IZ4) 



= 

CA?S <s> 

A// 2 
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SI N & 

N& 

= 

~ A/ /<? 

^££ 

— 

Nn 
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(X 1 2C?) 


On - Oj, A Ojg 

0*2. ~ 0>t, A//Z O/g P 22 

0*2 ~ 03 13 


il 

0>sj 

A/,/ 

*h 

Os? 

rt a , 

11 

o?t 

A/2 

+ 

0 2 2 

^ez 

0*3 * 

03 2 3 





>1 

% 5 

Pst* 

A/ 




£ 

11 

O0> 3/ 

^12. 





O 33 03 33 | 

(0/£7) 

Pn = o' P„ + 0,3 P 2 , + ^3 

” ^// ^2 '’’’ ^/3 p32 

P/3 “ ^3 *“ O/Z P23 0)3 P33 

P 2 I “ Oil Pt + -^22 + 03 33 P 31 

P#2 " ^7 ^/<2 + O2J P32 
PS3 = 0>Z, ^3 + 0 ? 2 Z P 2 3 + 0* 3 P 3 3 
P 3 ) ~ 0?3, P// + 0>3Z Pst + Os 3 Pi 
P 32 ~ O 31 P /2 * O 33 P$z 

P 33 ~ Of, P /3 A- O 32 Ps3 ^ O 33 P 33 
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D tv-re 


[-vie 

95 


* « 

Y-cr 

^ 12 


+ £ /a 

# 

Zc. 

0 0 

Ycp = 

£ 2! 

Xc 

+ ?23 

Zc 

ZeR ~ 

<$3J 

kc 

+ £32 

Ye 
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Symbol 

DELAY 


K, 


K„ 


K 


N 


k nt 

N 

-NMAX 

NC 

NCFM 


NF 


SYSTEM MATH FLOW SYMBOLS 

Definition 

Time delay to reduce syn error between radar 
and computer clocks 

Ellipticity of earth 

Magnitude of gravity in approach frame 

Magnitude of gravity in cruise frame 

Height of approach frame origin above reference 
geoid 

Height of cruise frame origin above reference 
geoid 

Preprocessor filter gain 

Preprocessor filter gain 

Bad data test logic (for self test) 

Bad data test logic (for self test) 

Indicates which set of -filter weights to use 

The number of sets of filter weights available 

The total number of updates completed 

Number of rejected radar measurements allowed 
before restarting update filter 

The number of rejected radar measurements since 
the last initialization 
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Symbol 


Dofinil Lon 


NFC 

NFMAX 

NP 

NSTS 


N.T 


NTMAX 

R 

e 

R' 

r 


t 

c 


At 

At 

At 


C 

2 


s 



The total number of rejected radar measurements 

The number of rejected radar measurements 
allowed before re -initialization if forced 

Counter used in preprocessor initialization 

Mode status indicator: 

0 initialization; 1 cruise nav. ; 2 approach nav. ; 

3 update in cruise; 4 update in approach 

The number of passes through the preprocessor 
since initialization or update • 

The number of preprocessor passes per update 

Earth equatorial radius 

Norm of radar positipn vector 

Preprocessor filter coefficient 

Time since "start comp" (i. e. , total navigation 
time) 

Integration interval 

Half the integration interval 

Time saved from fixed comp cycle control 

Time to begin approach navigation 

Time to inhibit radar updates 

Time of radar sample 

Self test stop time 

Integer time counter for fixed comp cycled control 
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Symbol 


Definition 


u 


V 


ET 


V 


NH 


K jc4, V. K -4 

(K x' K y ' K A2.3 


AC ,AC , AC 

x y z 


D , D , D 

X y Z 

F , F , F 
x y z 


F / , F' F' 

x y z 

F xl’ F yl’ F zl 

F ,F ,F 
xs ys zs 

G , G , G 
xo yo zo 

G , G , G 
xa ya za 

R , R , R 
x y z 


AR, A A, AE 


SF x t sf yi- sf zi 


SaV , SAV , SAV 
x y z 

u ix; u iy’ u iz 

u , u , u 

sx sy sz 


Time to begin radar update 
Vehicle east velocity 
Vehicle north velocity 
Accelerometer bias (Quanta) 

Accelerometer scale factor and misalignment 
coefficient 

Differential correction to platform drift or 
alignment from update filter 

Gyro fixed drift rate 

Accelerometer output in ft. /sec. (corrected for 
platform misalignment and bias) 

Accelerometer output with bias correction 

Accelerometer output (quanta) 

Accelerometer output for self test (quanta) 

Gravity components at cruise frame origin 

Gravity components at approach frame origin 

Radar data scale factor 

Radar bore sighting residuals 

Summation of accelerometer pulses 

Summation of corrected accelerometer output 

Gyro input axis mass unbalance 

Gyro spin axis mass unbalance 
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Symbol 
X, Y, Z 
AX, 'AY, AZ 


X a' Y a’ ?a 
X b- Y b- Z b 


X ,Y ,Z 
c c . c 

AX , AY , AZ 

c c c 


d d-d 


Definition 

Position output from radar preprocessor 

;<< ’ 

Difference Between predicted and measured 
radar position , 

Position in navigation frame at start of approach 

Radar data bias (Quanta) 

Position in navigation frame 

Integrated increment of position change 

Radar measured position synchronized to computer 
time 


X , Y , Z 
cc cc cc 


Second integral of total acceleration since pre- 
processor initialization or last update 



Z 

cp 


Nav. frame position predicted ahead one -half 
computation cycle 



Position of cruise frame origin in earth centered 
fixed frame ■ 



Position of approach frame origin in earth centered 
fixed frame 


X EC’ Y EC’ Z EC 

AX , AY , AZ 
m m m - 


Vehicle position in earth centered fixed frame 

Differential between predicted positions and that 
computed from IMU 


X , Y , Z 
P P P 

X„, Y_, Z„ 
R R R 


X, , Y , Z 
r r r 


AX , AY , AZ 
r r r 


Predicted position in radar preprocessor 

Radar measured position (quanta) 

Corrected radar data minus X , Y , Z 

cc cc cc 

Radar bore sighting corrections 
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Symbol 


X*, Y', Z ' 
r r r 


X , Y , Z 
rc rc rc 


AX„, AY , AZ 


AX , AY , AZ 
u u u 


• *6 

X , Y . Z 
c c c 

A X , AY , A Z 
c c c 


X , Y , Z 
cc cc' cc 


x d> Y d’ z d 


AX , AY , AZ 
' m m rn 


AX , AY ) AZ 
P P P 


AX'*, AY^, AZ'* 
P P P 


AX , AY , A Z 

s s s 

XT, YT, ZT 


AX , AY , AZ 
u u u 


X , Y , Z 
g g g 

*• •• 

X CR’ Y CR’ Z CR 


X CT’ Y CT’ Z CT 


Do finition 

Radar data with bias and scale factor correction 
t 

Radar measured position (feet) 

Tolerance for radar data check 

Differential correction to position from update 
filte r 

Velocity in navigation frame 

Total increment of velocity change 

Integrai of total acceleration since preprocessor 
initialization or last update 

Radar measured velocity synchronized to computer 
time 

Differential between predicted velocity and that 
computed from IMU 

Corrected accelerometer outputs in platform 
frame 

Corrected accelerometer outputs in navigation 
frame 

Integrated increment of computed velocity 

Velocity output from radar preprocessor 

Differential correction to velocity from update 
filte r 

Computed gravitational acceleration 
Computed coriolis acceleration 
Computed centripetal acceleration 
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Symbol 


Defintion 


°ta 

°^c 

'ga- 


ge 


0 

0 

a 

0 

c 

© 

V 

A© 


A.0 


* 


X a 

Xc 

Av 


Approach frame azimuth 
Cruise frame azimuth 
Platform azimuth 

Angle between plump bob and gravity vector 
(approach) 

Angle between plump bob and gravity vector 
(cruise) 

Integral of earth rate since start of navigation 
Longitude of approach frame origin 
Longitude of cruise frame origin 
Vehicle longitude 

Constant used in cruise frame computation 

Longitude between cruise and approach frame 
origins 

Geodetic latitude of approach frame origin 
Geodetic latitude of cruise frame origin 
Vehicle latitude 

Geodetic radius of approach frame origin 

Geodetic radius of cruise frame origin 

Mean radius of earth’ s polar axis 

Geocentric radius to reference geoid for approach 
frame 
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Symbol 


P 


sc 




CO 

e 


6 , 6,6 

xo yo zo 



P » P 

y z 


P XCT’ p YCT’ P ZCT 


• • / «r / ** ^ 

P XCT’ P YCT’ P ZCT 


Definition 

Geocentric radius to reference geoid for cruise 
frame 

Geocentric latitude of approach franie origin 
Geocentric latitude of cruise frame origin 
Earth rotational rate 
Initial platform misalignment 
Computed platform misalignment 

Position components used in approach initialization 

Centripetal acceleration of cruise frame origin 
Centripetal acceleration of approach frame origin 
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Logic Choices 


Symbol 

LC4A 

LC4B 

LCAN 

LCUD 

KLCUC 

LCN1 

LCN2 

LCN3 


Definition 

Logic choice to control preflight mode: + allows 
preflight initialization; - implies standard 
preflight 

Logic choice to control cruise navigation 
initialization: + allows cruise initialization; - 
allows navigation 

Logic choice to force the approach navigation 
mode: + allows cruise navigation; - forces 
approach navigation (DCS) 

Logic choice (3 way) to control radar update: 

+ inhibits update; 0 forces update; - forces 
update initialization (DCS) 

Logic choice to determine how the platform 
corrections are used: + corrects for platform 
alignment; - corrects for platform drift 

Logic choice (3 ways) to control initial program 
sequencing: + delays navigation until "start 

comp"; 0 zeros summed accelerations and time; - 
allows execution of the navigation equations 

Logic choice to indicate navigation frame: + 
implies cruise navigation and allows test to begin 
approach; - implies approach navigation 

Logic choice to indicate which filter weights to 
use: + use Koenke filter; - implies use of 

prestored weights 
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Definition 


Symbol 

LCN4 |_/Ogic choice indicating status of preprocessor 

filter initialization: + implies initialization not ' 
complete; - implies initialization completion 

LCN5 Logic choice indicating acceptability of radar 

measured data: + implies data can be used in 
preprocessor; - implies data unacceptable for 
preprocessor 

LCN6 Logic choice to inhibit MDIU: + allows MDIU; 

- inhibits MDIU 


LCN7 

LCS 

LCS1 

KLCUC 


Dll 3 
DI21 
DO05 


Logic choice to determine if platform correction 
is computed: + implies no platform correction; 

- implies platform correction 

Logic choice to execute self test mode: + implies 
regular navigation mode; 0 or - implies test modes 

Logic choice for self test mode: -f implies regular 
navigation mode; - implies test mode 

Logic choice to determine if platform drift or 
misalignment is corrected when using nine state 
mixing filter; + implies alignment correction; 

- implies drift correction 

Input discreet for pilot override on radar update 

Input discreet from "start comp" button 

Output discreet used to turn running light on and 
free platform 


040 



Matrices 


Symbol 

A 

AA 

C 

cc 


D 

DD 
N 
P 
Q 
- W 


k nij 


KC 


NIJ 


Definition 

Transforms navigation position to centripetal 
acceleration (cruise) 

Transforms -navigation position to centripe.tal 
acceleration (approach) 

Transforms navigation velocity to coriolis 
acceleration (cruise) 

Transforms navigation velocity to coriolis 
acceleration (approach) 

Transforms ECF to ESF (cruise) 

Transforms ECF to ESF (approach) 

Transforms ECI to ECF 

Transforms platform to ECI. 

Transforms ECF (cruise) to' ECF (approach) 

Transforms ESF (cruise) to ESF (approach) 

Prestored, filter weights for position and velocity 
update s 

Prestored filter weights for platform corrections 
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Appendix D 


IvlDIU/DCS/DAS QUANTITIES 

The input data required by the Gemini computer program is contained 
in Tables D-l and D-2. Those quantities in Table D-l are entired via the 
telemetry up-link, i. e. , the digital command system (DCS); and those in 
Table D-2 are inserted via the manual data insertion unit (MDIU) prior to 
flight. 

Tables D-3 and D-4 list the quantities that are telemetered down via 
the digital acquisition system (DAS) and recorded for post flight analysis. 
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Table D-l 


DCS Quantities 


' 



Input 

Computer 


Address 

Symbol 

Definition 

Format 

Range 

Units 

Scaling 

Units 

Comments 

00 


Spare 







01 


11 







02 


11 







03 


11 


• 





04 


11 







05 


It 







06 


11 







07 


11 







08 


It 







09 


It 







- 10 

LCUD 

Update control logic 

B 25 

+ or - 

ND 

B 25 

ND 

- Initiate update 



choice 






+ Inhibit update 

11 

LCAN 

Logical choice for 

B 25 

+ or - 

ND 

B 25 

ND 

- Switch to 



approach navigation 






approach nav. 

12 

T 

ru 

Radar data time 

B 13 

0 to 8191 

Sec. 

B 13 

Sec. 

High order bit in 
normal DCS sign 
position 

13 

X 

ru 

Radar Position data 

B 13 

0 to + 8191 

Quanta 

B 13 

Quanta 


14 

Y 

ru 

It 

II j 

It 

u 

It 

It 


15 

Z 

ru 

tl 

tl 

It 

11 

11 

11* 






















Address 


Symbol 


Definition 


Format 


16 

© 

c - 

Longitude of cruise frame 
origin 

XXX. XX 

17 

x c 

Latitude of cruise frame 
origin 

+ XX. XX 

18 

h 

c 

Height of cruise frame 
origin above reference 
spheroid 

+XXXX. 

19 

0 

a 

Longitude of approach 
frame origin 

XXX. XX 

20 

^ a 

Latitude of approach 
frame origin 

+XX. XX 

21 

h 

a 

Height of approach frame 
origin above reference 
spheroid’ 

+XXXX. 

22 

i> 

X 

H 

Radar data tolerance 

xxxx. X 

23 

ay t 

Radar data tolerance 

XXXX. X 

24 

az t 

Radar data tolerance 

XXXX. X 

25 

LCN7 

Logical choice for six or 
nine state filter 

+XXXX 

26 

NFMAX 

Max.- no. of bad radar 
data allowed per update 

■f XXXX. 

27 

NTMAX 

Number of preprocessor 
cycles per update 

+XXXX. 

28 

NMAX 

Number of update filter 
gain sets 

+XXXX. 


Input 

Computer 

Range 

Units 

Scaling 

Units 

0 to 360 

Deg. 

B 3 

Rad. 

,0.to.+ 67 

Deg. 

B 3 

Rad. 

0 to 500 

Yards 

B 24 

Ft. 

0 to 360 

Deg. 

B 3 

Rad. 

0 to + 67 

Deg. 

B 3 

Rad. 

0 to 500 

Yards 

B 24 

Ft. 

0 to 1000 

Ft. 

B 20 

Ft. 

0 to 1000 

Ft. 

B 20 

Ft. 

0 to 1000 

Ft. 

B 20 

Ft. 

+ or - 

ND 

B 25 

ND 

0 to 100 

ND 

1 B 25 

ND 

0 to 100 

ND 

B 25 

ND 

0 to 10 

ND 

B 25 

ND 


Comments 


+ six state 
- nine state 
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Table D-2 MDIU Quantities (Continued) 






Input 


Computer 

Address 

Symbol 

Definition 

Format 

Range 

Units 

Scaling 

Units 

29 

T 

u 

Time to enable update 

XXXX. X 

0 to 8191 

Sec. 

B 13 

Sec. 

30 

K 

xl 

Accelerometer scale 
factor 

+ . XXXX 

0 to +. 24 

fps/ 

pulse 

B -2 

fps/pulse 

31 

K , 
x2 

Accelerometer misalign- 
ment coefficient 

11 

II 

It 

tt 

It 

32 

K „ 
x3 

Accelerometer misalign- 
ment coefficient 

tt 

11 

tt 

11 

tt 

33 

K yi 

Accelerometer misalign- 
ment coefficient 

tt 

tt 

tt 

11 

It 

34 

K yz 

Accelerometer scale 
factor 

tt 

tt 

11 

II 

It 

35 

K y3 

Accelerometer misalign- 
ment coefficient 

11 

tt 

II 

« 

tt 

36 

K i 
zl 

Accelerometer misalign- 
ment coefficient 

11 

H 

II 

it 

tt 

37 

K n 
z2 

Accelerometer misalign- 
ment coefficient 

II 

It 

II 

it 

tl 

38 

K o 

z3 

Accelerometer scale 
factor 

11 

tl 

II 

it 

tl 

39 

K x4 

Accelerometer bias 
coefficient 

+X. XXX 

0 to + 3.9 

pulses/ 

sec. 

B 2 

pulses/ 

sec. 

40 

X y4 

Accelerometer bias 
coefficient 

+ X. XXX 

0 to + 3. 9 

pulse s / 
sec. 

B 2 

pulses/ 

sec. 

41 

K z4 

Accelerometer bias 

coefficient 

+X. XXX 

0 to + 3. 9 

pulses/ 

sec. 

B 2 

pulses/ 

sec. 


Comments, 
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Table D-2 


MDIU Quantities (Continued) 





Input 

Computer 


Address 

Symbol 

Definition 

Format 

Range 

Units 

Scaling 

Units 

Comments 

42 

AR 

Radar range bias 

+XXX. X 

0 to + 500 

Ft. 

B 13 

Ft. 


43 

AA 

Radar azimuth misalign- 

+. xxxx 

0 to + . 9 

Deg. 

B 3 

Rad. 




ment 




* ‘ 



44 

AE 

Radar elevation mis- 
alignment 

+ . xxxx 

0 to + . 9 

Deg. 

B 3 

Rad. 

• 

45 

6 

xo 

Initial Platform 
misalignment 

+X. XXX 

0 to + 1. 75 

Deg. 

B -5 

Rad. 


46 

6 

Initial platform 

11 

It 

IT 

It 

tt 



yo 

misalignment 







47 

6 

zo 

Initial platform 
misalignment 

11 

M 

11 

11 

tt 


48 


Spare 







49 


Spare 







50 

D 

X 

Gyro fixed drift rate 

+X. XXX 

0 to + 2 

Deg/ 

Hr 

B -10 

Rad/sec 


51 

D 

Y 

Gyro fixed drift rate 

II 

II 

II 

II 

II 


52 

D 

z 

Gyro fixed drift rate 

tl 

It 

It 

It 

II 


53 

U 

sx 

Gyro spin axis mass 
unbalance coefficient 

+X. XXX 

0 to + 1 

Deg/hr 

G 

B -17 

Rad/ sec 
Ft/sec^ 


54 

u 

xy 

11 

II 

II 

II 

11 

tt 


55 

u 

sz 

11 

11 

II 

II 

11 

* 11 


56 

U Ix 

Gyro input axis mass 
unbalance coefficient 

II 

II 

11 

tt 

It 



















Address 


Symbol 


Definition 


Format 


Input 

Range 


57 

U iy 

Gyro input axis mass 
unbalance coefficient 

+x. XXX 

0 to + I 

58, . 

" U Iz 

tt 

It 

It 

59 


Spare 



60 

P 

Platform azimuth 

XXX. XX 

0 to 360 

61 

c 

Cruise frame azimuth 

11 

tl 

62 

a 

Approach frame azimuth 

n 

II 

63 


i 

Spare 



64 


Spare 



65 

G 

c 

Gravity magnitude for 
cruise frame 

XX. XXX 

32 + 0. 7 

66 

G 

a 

Gravity magnitude for 
approach frame 

f! 

l? 

67 

€ 

gc 

Angle between plumb bob 
and gravity for cruise 

XX. XXX 

1 

0 to 10 

68 

c 

ga 

Angle between plumb bob 
and gravity for approach 

tl 

It 

69 

NFCM 

Max. no. of bad radar 
allowed between updates 
before restarting update 
filter 

xxxxx 

0 to 100 

70 

T 

a 

Time to initiate approach 
navigation 

xxxx. X 

0 to 8191 



Computer 

Units 

Scaling 

Units 

Deg/hr 

B -17 

Rad/sec 

G 


Ft/sec 2 

. , ii • 

it 

n 

Deg. 

B 3 

Rad. 

11 

ti 

II 

tf 

ii 

II 

**•' 2 
sec. 

B 6 

Ft/ sec^ 

h 

it 

ii 

Min 

B 3 

Rad. 

ir 

ii 

it 

ND 

B 25 

ND 

Sec. 

B 13 

Sec. 




Comments 













Table D-2 


MDIU Quantities (Continued) 





Input 

Computer 


Address 

Symbol 

Definition 

Format 

Range 

Units 

Scaling 

Units 

Comments 

71 

R 

X 

Radar data scale factor 

+X. XXX 

+ . 5 to + 4 

Ft 

B 7 

Ft 







Quanta 


Quanta 


72 

R 

y . 

n 

tt 

Tl 

It 

It 

tl 


73 

R 

2 

it 

II 

II 

It 

It 

It 


74 

K 1 
wl 

Comp, cycle control 
constant 

XX. XXX 

0 to . 1 

Sec. 

B 13 

Sec. 


75 

K w2 

Comp, cycle control 
constant 

XX. XXX 

0 to . 2 

Sec. 

B 13 

Sec. 


76 

K tc 

Comp, cycle control 
constant 

xxxxx. 

1000 to 3500 

Quanta 

Sec. 

B 12 

Quanta 

Sec. 


77 

“btc 

Comp, cycle control 
constant 

xxxxx. 

1 to 30 

Quanta 

' B 25 

Quanta 


78 


Spare 







79 


Spare . 







80 


Not available 







81 


II 







82 


. u 







83 

X b 

Radar bias coefficient 

+ XXX. X 

0 to + 8191 

Quanta 

B .13 

Quanta 


84 

V 

' It 

II 

. II 

It 

11 

It 


85 

z, 

D 

11 

11 

It 

tl 

11 

1! 


86 

LCSl 

Self test logic choice 

+ XXXX 

+ or - 

ND 

B 25 

ND 


87 

LCS 

Self test logic choice 

+XXXX 

+, - or 0 

ND 

B 25 

ND 




Table D-2 


MDIU Quantities (Continued) 





Input 

Computer 


Address 

Symbol 

Definition 

Format 

Range 

Units 

Scaling 

Units 

Comments 

88 

T 

F 

Time to terminate update 

xxxx. X 

0 to 8191 

Sec. 

B 13 

Sec. 


89 


Spare 







90 

T 

s 

Self test stop time 

xxxx. X 

0 to 8191 

Sec, 

B 13 

Sec. 


91 

F 

xs 

Accelerometer output for 

+ XXXX. 

0 to + 500 

Pulses 

B 12 

Pulse s 



self test 



Sec. 


Sec. 


92 

F 

It 

It 

11 

tl 

It 

ir 



ys 








93 

F 

>1 

tr 

tt 

11 

11 

if 



zs 








94 

z 

Preprocessor filter 

4*. XXXX 

. 5 to . 99 

ND 

B 1 

ND 




coefficient 







95 

Delay 


+ XXXX. 

0 to 150 

ND 

B 25 

ND 


96 

K 

n 

Bad data test logic 

+XXXX. 

0 to 1000 

ND 

B 25 

ND 


. 97 

K nt 

Bad data test logic 

+XXXX. 

0 to 10 

‘nd 

B 25 

ND 


98 

LCN3 

Logical choice for updata 

+ XXXJC 

'+ or - 

ND 

B 25 

ND 

+ Koenke filter 



filte r 






- 6 or 9 state 
filter 

99 


Spare 

, , 





















Table D-3 


DAS List (Preflight Mode) 


Sequence 

Number 

Symbol 

Description 

Units 

Scaling 

1 

SF . 

XI 

Summation of Accelerometer Pulses 

Pulses 

B 20 

2 

SF . 

y 1 

If 

U 

It 

3 

SF . 

Zl • 

tt 

II 

It 

4 

t 

Computer Time 

Sec. 

B 14 

5 

F . 

XI 

Accelerometer Output 

Pulses 

B 14 

6 

F . 

n 

tt 

II 

II 

7 

F . 

Zl 

It 

It 

It 

8 

AK 

bo 

Ladder Output 

Quanta 

B 14 

9 

A0, 

bo 

ft 

tl 

II 

10 

a *bo 

11 

II 

11 

11 

e b 

Platform Gimbal 

Quanta 

B 14 

12 

n 

tl 

It 

II 

13 

*b 

It 

tl 

II 

14 


Spare 



15 


MDIU Address Tag 



16 


Multiplexed MDIU Quantities 



17 


tt 



18 


It 



19 


II 



20 


It 



21 


tt 












1-10 


Table D-4 


DAS List {Navigation Modes) 


Sequence 

Number 

Symbol 

Description 

Units 

Scaling 

i 

SF . 

XI 

Summation of Accelerometer Pulses. 

Pulses 

B 20 

2 

SF . 

y i 

a 

tt 

tl 

3 

SF . 

Zl 

tt 

a 

It 

4 . 

t 

Computer Navigation Time 

Sec. 

B i4 

5 

X 

c 

Position in Navigation Frame 

, Ft. 

B 18 

6 

Y 

c 

tt 

tt 

n 

7 

Z 

c 

II 

II 

it 

8 

X 

c 

Velocity in Navigation Frame 

Ft. /Sec. 

* 

B 11 

9 

y 

. c 

a 

II 

It 

10 

z 

c 

tt 

ft 

II 

11 


Vehicle Latitude 

Deg. 

B 8 

12 

0 

V 

Vehicle Longitude 


B 9 

13 

V 

NH 

North Velocity 

Ft. /Sec. 

B 11 

14 

V 

ET 

East Velocity 



15' 

AX 

Delta Position Generated by Preprocessor Filter 

Ft. 

B 20 

16 

AY 

II 

II 

11 

17 

AZ 

tt 

tt 

II 

*18 

T , NSTS 
K. 

Radar Update Time, Mode Status 

Sec. 

B 14 

■ *19 • 

X RI NC 

Position From' Radar, No. of IMU Updates 

Quanta 

B 14 

*20 

y R , NFC 

Position From Radar, No. of Bad Radar Transmissions 

II 

tt 

21 

Z R 

Position From Radar 

If 

a 


* 

Radar data contained in first 15 bits with the indicator occupying the remaining 9- 



